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SUMMARY 


This report presents the research results from the research grant entitled "Active Control of 
Robot Manipulators", funded by the Goddard Space Flight Center, under the Grant Number 
NAG 5-780, for the period between July 1, 1988 and January 1, 1989. 

In this report, we present the analysis of a 6 DOF robot end-effector built to study telerobotic 
assembly of NASA hardwares in space. Since the end-effector is required to perform high precision 
motion in a limited workspace, closed-kinematic chain mechanism is chosen for its design. A 
closed-form solution is obtained for the inverse kinematic problem and an iterative procedure 
employing Newton- Raphson method is proposed to solve the forward kinematic problem. A study 
of the end-effector workspace results in a general procedure for the workspace determination based 
on the link constraints. Computer simulation results are presented. 


INTRODUCTION 


Performing operations outside of life supporting environments such as the future NASA space 
station is considered to be a relatively hazardous task. Therefore, the concept of using space 
robots instead of astronauts for servicing and maintaining spacecrafts attracts tremendous 
robotic researchers’ attention. Recognizing the above fact, NASA has focused on the research of 
telerobotics , a joining of teleoperation and robotics [1]. Teleoperation enables the human opera- 
tor to perform tasks remotely in a shirtsleeve environment and robotics allows tasks, which are 
impossible to human control by teleoperation to be accomplished by a telerobot. Telerobotic 
operations can be performed either in a traded control mode (serial operation) or in a shared 
control mode (parallel operation). In the traded control mode, using teleoperation the human 
operator performs some portion of a task and then let the telerobot perform some other portion 
of the task autonomously. On the other hand, the human operator and the telerobot perform 
portions of the task simultaneously in a shared control mode. In either modes, successful robotic 
tasks require that the motion of the telerobot be controlled precisely. Robot motion can be cat- 
egorized into gross motion and fine motion. While gross motion permits low position tolerances, 
e.g. in obstacle avoidance, fine motion requires a relatively high position tolerance, usually of 
thousands of an inch, e.g. in mating and fastening of parts. A telerobot system mainly consists 
of a master arm and a slave arm [Figure 1] which is a general open-kinematic chain (OKC) 
manipulator with six degrees of freedom (DOF) or more. During an assembly task, it is im- 
practical to require the OKC manipulator to perform both gross and fine motion since OKC 
manipulators generally have poor performance in a fine motion operation. Therefore, the opera- 
tion is more effective if a robotic end-effector possessing a capability of high precision positioning 
is mounted to the end of the OKC manipulator to perform fine and precise motion while the 
OKC manipulator performs only gross motion. The above distribution of tasks actually occurs 
in an operation performed in a traded control mode where the operator uses the master arm 
to move the OKC manipulator into the end-effector workspace in a gross motion mode and the 
end-effector will take over and perform the assembly autonomously in a fine motion mode. 

Although OKC manipulators have large workspace and possess high dexterity, they are not 
used as high precision positioning devices because the cantilever-like structure causes the robot 
arm to have low stiffness. In addition, OKC manipulators have low vibrational frequencies due 
to the accumulation of effective masses associated with manipulator actuators and their open 
chain structure. In this kind of manipulators, large position error occurs at the last link because 
actuator errors accumulate throughout the OKC mechanism. Finally OKC manipulators have 
low strengh-to-weight ratios due to the fact that payloads are not uniformly distributed to 
the actuators. The above disadvantages of OKC manipulators have motivated active research 
of an alternative type of manipulators designed based on closed-kinematic chain mechanism 
(CKCM). A typical CKCM manipulator consists of two platforms driven by a number of parallel 
actuators and is often referred as parallel mechanism or parallel manipulator . Paying the price 
of relatively small workspace and low maneuverability, CKCM manipulators enjoy the high 
positionioning capability produced by their high structural rigidity and noncumulative actuator 
errors. CKCM manipulators also have higher strenght- to- weight ratios as compared to OKC 
manipulators because their actuators share the load proportionally. In summary, the CKCM is 
an ideal device for robotic tasks that require high precision motion within a limited workspace, 
e.g. in a fine motion mode of the telerobot end-effector. 
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Implementation of the CKCM concept first appeared in the design of the Stewart platform 
[2], originally designed as an aircraft simulator whose motion control problem was considered 
later in [3]. After its introduction, the Stewart platform mechanism attracted considerable 
researchers’ interest and was proposed in many robotic applications [4,11]. New structural 
designs of robot arms based on the Stewart platform were proposed in [4] and motivated further 
development in [5]. A general technique was developed in [6] to describe the instantaneous 
link motion of a single closed-loop mechanism by employing linear algebra elements to screw 
systems. The author in [7] investigated the structural kinematic problem of in-parallel robot 
manipulators. A passive compliant robot end-elfector was manufactured in [8] by utilizing the 
concept of Stewart platform mechanism whose kinematic problems and practical construction 
were later considered in [9] and [10], respectively. Investigation of inverse dynamic problem 
of platform- based manipulators was done in [11] and analysis of kinematics and dynamics of 
parallel manipulators was conducted in [12]. Dynamical equations for a 3 DOF CKCM and a 
2 DOF CKCM manipulator were derived in [13] and [14], respectively by using the Lagrangian 
formulation. 

Since CKCM is capable of performing high precision motion in a relatively small workspace, 
it is natural to propose that it be utilized in designing the end-effector to be mounted to the 
slave arm of the telerobot system to perform fine motion. As a consequence, a 6 DOF robot end- 
effector whose structure assumes a CKCM was recently designed and built to serve as a testbed 
for studying telerobotic assembly of NASA hardwares [8] in space. In this report, we first describe 
the main components of the CKCM end-effector. We then present the kinematic analysis which 
provides a closed-form solution to the inverse kinematic problem and an iterative procedure 
using Newton-Raphson method for the solution of the forward kinematic problem. Next we 
examine the workspace problem and then propose a general procedure for the determination of 
the reachable workspace for a set of link constraints. Computer simulation is then performed to 
demonstrate the procedure. Finally, evaluations and discussions of obtained results will conclude 
the report. 

THE CKCM END-EFFECTOR 

Figure 1 presents an artist’s conception of a dual arm telerobot system consisting of a master 
system and slave system. The human operator uses the master arm to control the gross motion 
of the slave arm and the CKCM end-effectors mounted at the end of the two slave arms au- 
tonomously perform part assembly in a fine motion mode within its workspace. The end-effector 
should be manufactured such that it satisfies the requirements of compactness and lightweight. 
In order to study the performance of autonomous assembly of parts in a telerobotic operation, a 
6 DOF end-effector whose size is about ten times that of the telerobot end-effector was designed 
and built at the Goddard Space Flight Center (GSFC) [8] and is currently located at the Center 
for Artificial Intelligence and Robotics (CAIR) 1 . As shown in Figure 2, the end-effector is a 
modified version of the Stewart platform, and mainly consists of an upper payload platform, a 
lower base platform and six linear actuators. The movable payload platform is supported above 
the stationary base platform by six axially entensible rods where recirculating ballscrews are 
used to provide the extensibility. Stepper motors were selected to drive the ballscrews to extend 

'To test control schemes developed under a research grant with NASA/GSFC 
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or shorten the actuator lenghts whose variations will in turn produce the motion of the payload 
platform. Each end of the actuator links is mounted to the platforms by 2 rotary joints whose 
axes intersect and are perpendicular to each other. Therefore, the system has 24 rotary joints, 
6 prismatic joints, and 14 links including the 2 platforms. Using the number synthesis [4], it can 
be shown that the CKCM end-effector possesses 6 degrees of freedom. 

THE INVERSE KINEMATICS 

In this section we first start developing the kinematic equation for a 6 DOF end-effector and 
then discuss the special cases of end-effectors having smaller number of degrees of freedom. 
Inverse kinematics deals with the determination of a set of joint variables, which yield a set of 
Cartesian variables, usually composed of Cartesian position and orientation of the end-effector 
with respect to some reference frame. For the CKCM end-effector, the lenghts of the links can 
be adjusted by the actuators, and therefore are chosen to be the joint variables. To define the 
Cartesian variables we proceed to assign two coordinate frames {A}, and {B} to the movable 
and base platforms, respectively. As Figure 3 illustrates, the origin of Frame {A} is chosen to be 
the centroid A of the payload platform, the z^-axis is pointing upward and the x^-axis passes 
through the joint attachment point A\. The angle between A\ and Ai is denoted by 8 a, and in 
order to obtain a symmetrical distribution of joints on the payload platform the angles between 
A\ and A 3 and between A 3 and A 5 are set to 120°. Similarly, Frame {B} has its origin at the 
centroid B of the base platform. The xg-axis passes through the joint attachment point B\ and 
the angle between B\ and B2 is denoted by 0g. Also the angles between B\ and B3 and between 
B3 and Bs are set to 120 ° so that a symmetrical distribution of joints on the base platform 
can be achieved. The Cartesian variables are chosen to be the relative position and orientation 
of Frame {A} with respect to Frame {B} where the position of Frame {A} is specified by the 
position of its origin with respect to Frame {B}. Now if we denote the angle between AA,- and 
Xyi by A,-, and the angle between BB{ and xb by A i for i= 1 ,2,. . . , 6 , then by inspection we obtain 

A , = 60(* - 1)°; A,- = 60 (i - 1)° for i =1,3,5 (1) 

and 

A,- = A,_i + 0g; K = A,_i + 8 a for i = 2,4,6. (2) 

Furthermore, if Vector = (a, x a,„ a,- 2 ) r describes the position of the attachment point A, 
with respect to Frame {A}, and Vector B b, = ( 6 IX 6 , y 6 ,*) r the position of the attachment point 
Bi with respect to Frame {B}, then they can be written as 

r,*sin(A t ) 0 ] T (3) 

rgsm(A,) 0 ] (4) 

for i= 1 , 2,. ..,6 where and rg represent the radii of the payload and base platforms, respec- 
tively. 

We proceed to consider the vector diagram for an ith actuator given in Figure 4. The lenght 
vector ®q, = (g, x </, y qi z ) T , expressed with respect to Frame {B} can be computed by 

B q, = B a, - B b. (5) 


'"a, = [ r A cos(\i) 

and 

S b, = [ rgcos(A,) 
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where Vector B a, and Vector B d describe the positions of A; and A, respectively both in terms 
of Frame {B}. Vector B d contains the Cartesian coordinates x, y, z of the origin, A of Frame 
{A} with respect to Frame {B} such that 

B d = ( x y z ) T . (6) 

Let B R be the Orientation Matrix , which represents the orientation of Frame {A} with 
respect to Frame {B} and can be expressed as 


**11 

**12 

fl3 

T21 

**22 

7*23 

r 31 

**32 

^33 


for i=l,2,. . . ,6, then B a, can be computed by 

B a, = B R A aj 4- B d. 


(7) 

( 8 ) 


Now substituting (8) into (5) yields 


B qi = b R A &i + B d- B b, for i=l,2,. . . ,6, 


(9) 


which can be rewritten as 


B 


q. = 


t ii ®ir + ri2a ty + r 13 a, z + x — b{ x 

^2ia«'r + Tlldiy + r 23«tz + V — b{ y 

TziO.ii -f r 32 a, y + r^aiz + z — b{ z 


( 10 ) 


Furthermore, the lenght of Vector B q,-, h can be computed from the vector components as 


l i = \J Wx + lly + ( tlz 


( 11 ) 


Employing (10), Equation (11) can be rewritten as 

U 2 = * 2 + y 2 + 2 2 + a- I (rn+ r 21+ r 3l) + a ?y( r !2 + r 22 + r 32) 

+ a lz( r 13 + r| 3 + rjj) + b 2 x + b 2 iy + b 2 iz + 2a, x a, y (r X iri 2 + r 2X r 22 + r 3 ir 32 ) 
+2a,>a >z (rnri 3 -f r 2 ir 23 + r^r^) + 2a, y a, z (ri 2 ri 3 + r 22 r 23 + r^r^) 

+2(r n o, x + r 12 a, y + ri 3 a, z )(x - b ir ) + 2(r 2 ia ix + r 22 a iy + r^a^Xy - b iy ) 
+2(r 31 a tx + r 32 a, y + r 33 a iz )(z - b iz ) - 2 (xb ix + yb iy + zb iz ). (12) 


From the properties of orientation matrix we have 


2 , 2 , 2 _ 
r n + r 2i + r 3i - 


Jl ,2 , _2 _ „2 , „2 I -2 •» 

r 12 + r 22 + r 32 “ r 13 + r 23 + r 33 — 1 


(13) 


and 


rii»*i2 + »"2ir22 + r 31 r 32 = 0 

rxiri 3 + + r 31 r33 = 0 

fll r 13 + **22 r 23 + r 32 r 32 = 0* 


(14) 
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and also from (1) and (2) we note that 




a,z = bu = 0 (15) 

and 

4+4+4 =4 (16) 

4 + 4 + 4 = 4- (17) 

Therefore, (12) can be simplified to 

/i 2 = x 2 + s/ 2 + z 2 + r\ + r| + 2(riia, x + ri 2 a ty )(a; - 6, x ) 

+2(r 2 ia, x + r 22 o, y )(y - 6, y ) + 2(r 3 ia,> + r 32 a, y )2 - 2(xb ix ), (18) 


for i=l,2,. . . ,6. 

Equation (18) represents the solution to the inverse kinematic problem in the sense that for 
a given Cartesian configuration, composed of the position and orientation specified by (6) and 
(7), respectively, the actuator lengts li for i= 1,2,* . . ,6, can be computed using (18). We observe 
that nine variables are needed to describe the orientation of Frame {A} in Equation (7) and 
six of them are redundant because only three are needed to specify an orientation [18]. There 
exist several ways to represent an orientation by three variables, but the most widely used one 
is the Euler Angles a, /3, and 7, which represent the orientation or Frame {A}, obtained after 
the following sequence of rotations from Frame {B}: 

1. A rotation of a about the zg-axis ( Roll) 


2. A rotation of /3 about the yg-axis (Pitch) 


3. A rotation of 7 about the xg-axis ( Yaw). 

The orientation represented by a, (3, and 7, is given by 2 


Rryz(<*> /^> 7) 


ca c/3 ca s/3 sy - sa cy ca s/3 c 7 + sa sy 
sa c(3 sa s/3 sy + ca cy sa s/3 cy - ca sy 
-s/3 c/3 sy c/3 cy 


(19) 


Figure 5 illustrates the application of the inverse kinematics in a joint-space control scheme 
where the desired position and orientation of the payload platform, specified by six variables 
x,y,z,a,/?, and 7 are converted to required actuator lenghts by using Equations (18) and (19), 
and to be compared with the actual lenghts measured by displacement sensors such as linear 
voltage differential transformers (LVDT), mounted along the actuator links. 


Special Cases 

We observe that the solution to the inverse kinematic problem presented by Equation (18) is 
expressed in term of the vectors and B b,, which depend on A,- and A,-, respectively. To make 
the solution applicable to end-effectors which has a smaller number of degrees of freedom, we 
modify Equations (1) and (2), while preserving the symmetrical distribution of joints on the 
payload and base platforms to include the following cases: 

3 car = cos a, and sa = sin a. 
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( 20 ) 




# 


Even Number of DOF: 

A, 


360 /. . 

— (* - 1) ; A, 

n 


— (* - 1)° for i = odd. 
n 


and 

A , = Ai-i + 0 B ; A < = A,_i + 0 a /or i = even. (21) 

where n = 2,4,6, is the number of DOF and 9a and 0 B are arbitrarily selected by the designer 
of the end-effector. 


Odd Number of DOF: 

A,- = A,- = ^^(i - 1)° for i = 1,2, ..., n (22) 

n 

where n = 1,3,5, is the number of DOF and it is noted that in this case, 9a = 9 B = 

Investigations of several special cases were reported in [14] for 2 DOF, in [13] for 3 DOF and 
in [9] for 6 DOF, whose joint distributions all agree with (20)-(22). 


THE FORWARD KINEMATICS 

The forward kinematics deals with determining the position and orientation of the payload 
platform when the actuator lenghts /,■ for i=l,2,. . . ,6, are given. This situation often occurs in a 
Cartesian-space control scheme where the lenghts measured by the LVDT’s are to be converted 
to the corresponding payload platform position and orientation which are then compared with 
the desired configuration specified by the user. 

Let us consider Equation (9), in which the orientation matrix is replaced by R xyz (a,f3,*f) 
described in (19). In (9), if B q ,• were available, for i=l,2,. ..,6, then with 18 equations and 
12 unknowns including r,* for j=k=l,2,. . . ,3, and x,y,z, the solution could be obtained in a 
closed-form expression. The orientation angles a,/?, 7 can then be found by solving the inverse 
kinematic problem of the Euler Angles [18]. However, since there exists no unique vector B qj for 
a given lenght the above approach is not feasible. In addition, sensors measuring Cartesian 
coordinates are not readily available while joint displacement sensors such as LVDT are usually 
off-the-shelf items. Consequently, in a practical situation, only the information of the actuator 
lenghts is available, and it leaves us no alternative but to apply Equation (18) to solve the 
forward kinematic problem. 

The forward kinematic problem can be now formulated as to find a vector B d (position) and 
a matrix R xy *(a,/?,7) (orientation) such that for a given set of /, for i=l,2,. . . ,6, Equation (18) 
holds. We recognize that it is a difficult, if not impossible task because we have to deal with a set 
of 6 highly nonlinear simultaneous equations with 6 unknowns. Similar to the inverse kinematics 
of OKC manipulators, generally there exists no closed-form solution for the forward kinematics 
of CKCM manipulators. It leads us to seek an iterative numerical method to solve the above set 
of nonlinear equations. One widely used technique for solving nonlinear equations has been the 
Newton-Raphson method [19], which is proposed in this section to solve the forward kinematic 
problem. 

In order to apply the Newton-Raphson method, first we should define 6 scalar functions 

/,( a) = 0 for i =1,2,- . . ,6 (23) 
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where the vector a is defined as 


# 




a=(z y z a (5 7 ) , 
and then employ the iterative formula 

a/fc+i = at - [J(ajt )] -1 f(ajt) 


where 


f(a) = [ fi T (a) f 2 T (a) f 3 T (a) £, T (a) f 5 r (a) ^ T (a) ] , 

and the Jacobian matrix J of f is given by 

9fi 9fi 9fi 9fi 9f| 9fi 


J = 


dx dv dz da dQ dy 

d^2 912 d$2 Bl2 

dx By dz da dp By 


die dfs d}6 affi dig d 

dx By dz da 8(3 ~8*y J 


until certain acceptable error is achieved. 

The scalar functions specified by (23) can be found by rewriting (18) so that 


(24) 

(25) 

(26) 


(27) 


x 1 + y 1 + z 1 + r\ + t\ + 2(riia,* + ri 2 a, y )(x - 5^) 

+2(r 2 ia,x 4- r 22 a, y )(y — 6, y ) + 2{rz\o.ix + »*3 2 a, y )z — 2(xb{ x ) — li 2 = 0, (28) 

for i=l,2,. . . ,6. The following algorithm summarizes the application of Newton-Raphson method 
in solving the forward kinematic problem 


Algorithm 1 

1. Select an initial guess ai. ? 

2. Compute f,(ai) for i=l,2,. . . ,6 using (28). 

3. Compute J(ai) using (27). 

4. Compute a 2 using (25). 

5. Compute the difference between a 2 and ai. 

6. Repeat Steps 1-5 until an acceptable difference is obtained. 

In Step 6, an acceptable error can be established by setting up a tolerance value T so that 
when the element e* of the error vector e at the k iteration given by 

e=-J~ l f(* k ) (29) 


satisfy 






* = 1 


( 30 ) 
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To investigate the performance of the above algorithm, we implement it using a software 
package, called System Simulation Language (SYSL) on a PC AT to study the case in which 
the end-effector draws an ellipse defined by 

(f)’ + (m ) 2 = 1 (in cm) (31) 

on a plane parallel to the base platform. The NASA end-effector parameters are = 0.7m, 
rg = 0.8m, 6a — 30°, 6g = 94°, / m ,„ = 40inches, and l max = 53inches. Here for simplicity, it 
is assumed that the payload platform frame {A} maintains a fixed orientation with respect to 
the base platform frame {B} while performing the motion. We first use the inverse kinematics 
to derive the actuator lenghts required for drawing the ellipse. The lenght information is then 
inputted to Algorithm 1 with a sampling rate of 10 Hz to obtain the Cartesian variables. The 
data obtained from the algorithm is plotted against the actual ellipse for comparision purpose. 
As Figure 5 shows, the proposed algorithm performs satisfactorily by providing relatively ac- 
curate information about the actual ellipse with minimal deviations. Its performance could be 
improved if the sampling rate is reduced and a faster computer is used. Real-time control of 
the end-effector requires that the sampling rate be at least 5 Hz [16]. Therefore, with a fast 
computer and a smaller number of iterations, Algorithm 1 can be implemented for converting 
lenght information into position and orientation in a real-time control problem. Successful im- 
plementation of Newton- Raph son method for real-time control with one iteration was reported 
in [3]. 

DETERMINATION OF WORKSPACE 

Workspace analysis of CKCM end-effectors having 6 DOF or more is a difficult task due to fact 
that its spatial geometry of multiloop structure is highly complex, which results into the non- 
existence of a closed- form solution for the forward kinematic problem. The reachable workspace 
of the end-effector depends on the maximum extension and shortening of the actuator lenghts 
and allowed ranges of joint rotation. In [9], the authors analyzed the reachable workspace of a 
6 DOF manipulator with ball joints that are evenly distributed on both the platforms. They 
considered a special case in which the payload platform is allowed only to rotate about the 
y-axis, i.e. the rotations about the x-axis and z-axis are forbidden. As pointed out in [9], ball 
joints can only move freely with respect to all three Cartesian axes within the allowed ranges 
based on their physical dimension. As mentioned before, in the implementation the CKCM 
end-effector considered in this report, 2 rotary joints were utilized to connect each end of the 
actuator links to the platforms. Rotary joints were used instead of ball joints, because they 
require minimal maintenance and do not restrict the reachable workspace of the end-effector. 

In this section we propose an algorithm that can be implemented to determine the reachable 
workspace of a general 6 DOF CKCM end-effector with rotary joints whose distributions on 
the platforms are arbitrary provided that a symmetrical distribution is preserved subject to 
(20)-(22). The algorithm employs both inverse and forward kinematic solutions and is given 
below: 


Algorithm 2 

1. Select a workspace bounded by the surface of a sphere whose origin is located at [0 0 ( z max — 

r m m)] T where r mtn , the sphere radius is equal to , z max , the maximum vertical 

coordinate is obtained when all lenghts /j for i=l,2 v . . ,6 are extended to maximum values, 
and z mtn , the minimum vertical coordinate is obtained when all lenghts /,• for i=l,2,. . . ,6, 
axe shortened to minimum values. The sphere selected here is the maximum sphere, on 
whose surface all points can be reached by the end-effector. 

2. Use inverse kinematics to obtain the required lenghts of the surface of the sphere selected 
in Step 1. 

3. Delete those points on the sphere surface, which correspond to lenghts that lie outside the 
allowed range specified by the lenght constraint, / m , n < /,• < l max - 

4. Select another sphere whose radius r is equal to r m + A r, for A r > 0. 

5. Repeat Steps 1-4 until r = r max where r max is the radius of the smallest sphere, on whose 
surface no point can be reached by the end-effector. 

6. Plot the remaining space points in 2-dimensional or 3-dimensional coordinate systems. 

To demonstrate the performance of Algorithm 2, we applied it to determine the reachable 
workspace of the NASA CKCM end-effector whose specifications were given in previous section. 
Algorithm 2 was implemented using SYSL and Matlab on a PC AT. The results are reported in 
Figures 7-9. Figure 7 shows the x-y plane projection of the reachable workspace while Figures 
8 and 9 the x-z plane and y-z plane projections, respectively. As the figures show, the reachable 
workspace of the end-effector has the shape of a deformed football, which is as expected. 

CONCLUSION 

In this report we presented the kinematic analysis of a 6 DOF CKCM end-effector whose design 
was based on the mechanism of Stewart platform [2]. Since CKCM has high precision posi- 
tioning capability within a limited workspace, we have proposed that the CKCM end-effector 
be mounted to the end of a telerobot to perform autonomous assembly of NASA hardwares in 
space. The kinematic analysis of the end-effector was performed and resulted in a closed-form 
solution for the inverse kinematic problem so that required lenghts can be computed for a given 
Cartesian configuration. Newton-Raphson method was employed to treat the forward kinematic 
problem whose solution can be obtained iteratively using a proposed algorithm (Algorithm 1). 
Determination of the end-effector workspace was also considered and an algorithm (Algorithm 2) 
was provided to compute the reachable workspace of a general CKCM end-effector. Computer 
simulation was conducted to investigate the proposed algorithms. Future research can be ex- 
tended to studying the dynamics of CKCM end-effectors [15] and control schemes for controlling 
position and force [16] of this type of robot end-effectors. 
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